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A laboratory design facility for digital microprocessor implementation of 
Linear-Quadratic-Gaussian feedback compensators is described. Outputs fren 
user interactive program.--, for solving infinite time horizon LQ regulator 
and Kalman filter problems are conditioned for implementation on a labora- 
tory microcomputer system. The software consists of two parts: (1) an off- 
line high-level program for solving the L2 Ricatci equations and generating 
associated feedback and filter gains and (2) a cress conpiler/macro as- 
sembler which generates object code for the target microprocessor system. 

A digital Equipment Corporation PDP 11/70 with a UNIX Operating System is 
used for all high level program and data management, and the target micro- 
processor system is an Intel MDS (8080-based processor). Application to 
the control of a two dimensional inverted pendulum is presented and issues 
in expanding the design/prototypmg system to other target machine 
architectures are discussed. 


I. INTRODUCTION 

The potential impact of microprocessors on control technology has been 
widely acclaimed. While control design methods for sampled-data systems 
have been known for a good many years (Kuo, (1); Bryson and Ho, (2)), they 
were until recently only economical for relatively large systems, where 
the cost of A/D, D/A interfaces and minicomputer couid be justified (typi- 
cally $20-30K) . '« wever, the complexity of such, large systems often made 

testing and evali.nt on difficult, further impeding the implementation of 
computer controls. 

While the microprocessor has indeed substantially reduced a major cost 
barrier, and more signf iicantly, opened up a wider range of simpler control 
applications, we consider it premature to view the microprocessor as a 
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panacea for the experienced control engineer* lot alone the college or 
graduate student. Ironically, the microprocessor has presented now bar- 
riers to the control designer! assembly-' anguago programming, coding Tor 
real time execution, and many other hardware synchronisation problems. 

The no problems are by no moans insurmountable but in our opinion they are 
much alleviated by a development system involving a larger machine with 
highor level language and multiprocessing capability. 

Our purpose herein will be to (laser lb a a prototype nicroproccnoor design 
facility and to communicate the key insights which lave been gained thus 
far in its development. The facility consists of high and low-level soft- 
ware, computer hardware, and a continuous target application involving a 
two degree of freedom inverted pendulum. 

II. SOFTWARE DESCRIPTION 

2.1 Design Coals 

The utility of a laboratory microprocessor control design facility depends 
critically on itn software and hardware organization. At the outset of 
this project, several goals were established to address both educational 
and research needs of digital control system designers! 

(1) High level languages should be employed a*- all design 
levels, in flexible, multi user-i ntorarcive (time- 
sharing) environment i 

(2) A control oriented symbolic language for required data 
processing activities (control laws and filters) should 
bo available to simplify use of the system) 

(3) Software developed in the hich level language should be 
applicable to many target machines) 

(4) Object code generated should be optimized for the target 
machine to permit exploitation of available processing 
speed 

With these ns long term goals for the structure of desirable software, 
a prototype system has been developed in the contrxt of a specific 
(PDP-11) operating system and target roici ©processors (Intel 0000). 

The HIT System incorporates several novel features which allow the user to 
Accomplish algorithm design in a higher-level language (FORTRAN), develop 
real-time code in using powerful assembly-language macro commands, which 
are translated into relocatable object code and finally cross-assembled 
automat ica l ly for the microprocessor itself, and automatically down-loaded 
into microprocessor memory. 



2.2 i.i h ; ci impen;. it oi Deal gn 


The organization of the higher-level Fortran routines for bpc. compensator 
design is shown in Figure 1. Note that other alternative design packages, 
such as classical frequency-domain or multivariable frequency domain 
methods could be used equally well hero. In the prototype system, the de- 
signer does off-line calculations of controller gains by writing very 
elementary FORTRAN programs using these higher-level routines; alternative 
ly he can employ a specially developed user-inter tetivo program which 
covers most infinite tim > horizon continuous and discrete LQG filter and 
control problem .. The solution method for thi • off-l ine design phase in 
the prototype system employs fairly standard eigenvalue decomposition 
techniques which were developed at the HIT Electronic Systems Laboratory 
(3). These FORTRAN programs in turn depend on t "niPFAK" eigenvalue/ 
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eigenvector package developed at Argonno Laboratory; this in widely available. 
User developed or available interactive programs for post-procoor.ing of 
control and filter designs {including simulation) a r - useful before 
proceeding to generate code for the target microcomputer system:.. 

2 . 3 Code Generator for Target Micro Co mputer System 

Aftor completing the off-line design phase described in 2.2, code to imple- 
ment the control law and/or filter algorithm on the target micro computer 
system is generated following the procedure outli-.ei in Figure 2. This 
activity consists of three main parts: (1) Generation of an assembly pro- 
gram using a collection of previously defined control-specific macros 
(MACGEN Figure 3) j (2) Cross assembly of the user generated program (a 
source collection of macros) into executable absolute object code (DOMIC 
Figure 4); (3) down loading of the absolute code into the target system, 

The DOMIC program performs the steps illustrated in Figure 4 which includes 
binding of the relocatable user object files from the (MICAL) crosr as- 
sembly with the previously defined control macros, and conversion of the 
resulting files into absolute (executable) coda for the targot micro- 
computer system. The tedium of performing these procedures manually is 
thus eliminated for the user. Note that tho user-defined macro source 
program written with MACGEN is canonical , in that by use of a different 
cross assembler in MICAL, other target processors can be employed. For 
example, in our prototype system, both Intel 8030 ar.d Motorola 6900 
processors can bo employed as the target system. Furthermore, the use of 
special architectual units such as hardware multiply, array processors, 
etc. can be made essentially invisible to the control designer blnce the 
special needs of these units (or even I/O devices) are encoded in the 
library of MACGEN routines. All program generation in tho above system 
is handled under the supervision of the host operating system, which in 
the M.IT prototype was "UNIX" us implemented on a DEC ?DP 11/70. The power- 
ful text editing and file handling capabilities of such systems (or 
similar) are, in our view, essential in an educational or research environ- 
ment so that the user (student or researcher) can concentrate on the 
control/estimation aspects of the problem. 

2.4 A Simple Example 

It would be impossible in this space to enumerate all the capabilities 
of the current system implemented at MIT. We will bo content to illus- 
trate the heart of the software, the MACGEN program, with a simple Ex- 
ample. A program for a state regulator with (second-order) dynamics (one- 
input and two-outputs) is illustrated in Figure 5. The general flow of 
this program is illustrated Figure 6, which also illustrates some addi- 
tional special features in our prototype system. T-e processor is 
assumed to be interrupt driven by an external clock. At each sample time 
the interrupt routine (INT5:) is serviced. A/D conversions are performed 
setting 

» A/D PORT <}> 

X = A/D PORT 1 

ORIGINAL 

Then OF POOR 

U - Vl + g 2 x 2 

is output th -ugh port <{> of tho D/A converter: the elements of 

"gain" are set in the routine called "ready”. The real time operation of 
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this program as it resides in the targ«t machine is explained with tha aid 
of Figure 5a. When the hardware is initialized, the program sets up 
specified conditions on I/O devices and fetches the required gain data and 
puts it in a tabic. A real tine monitor program (READY) is then entered 
which can accept simple commands from a terminal to run, quit, change the 
gains, etc., all on-line. The control up-dates are accomplished by an 
external (prioritized) clock interrupt, which causes tho branch to "INT5". 
The program then returns to the READY monitor program. 

This example illustrates the relative simplicity of using the mnemonic 
macros to generate code control updating for real-time (interrupt-driven) 
operation. More complex control laws including filters, observers, or 
classical lead-lag compensators are easily constructed with the currently 
available collection of macros. 


III. HARDWARE 

3.1 Prototype System 

The prototype software described above was implemented as shown in Figure 
7 on a DEC PDP 11/70 with 64K of memory, n. conjunction with an Intel 8000 
based MDS-800 (Development) as the target micro computer system. The MDS 
system employed hardware multiply, 16K of memory and was outfitted with 
the Datel D/A and A/D cards shown. (32 A/D inputs, 16 A/D outputs). Two 
precision D.C. servo amplifiers were provided to drive high power loads 
(up to 10A. 0 28V.) for simple control designs. A number of custom soft- 
ware modules were written or adapted from available software to handle 
communications between the MDS monitor and UI.'IX at the 9.6 K-band rate 
(including down-load find plotting of hardware results). We believe that 
our system is well above the minimal "threshold" to support the design 
software, although no attempt was made to define what lower bound on hard- 
ware would suffice. One the other-hand, nore sophi stiented target systems 
could have been employed. 

3.2 An Application 

The prototype system was applied to the design of a two degree of freedom 
inverted pendulum. The pendulum was a SO" long aluminum pole mounted on 
a gimbal as shown in Figure 0. The gimbal is mounted to a large (‘58*' x 48") 
drafting-type X-Y plotter. It consists of a cart which can be translated 
along an aluminum rail to obtain "X" displacement, and the rail in turn 
can be translated to obtain "Y" displacement- . Motion is achieved with a 
system of cables and pulleys connected to two 28 volt D.C. servo-motors 
which can be driven with the amplifier outputs from the system described 
in 3.1. Linearized analysis of the one-dimensional inverted pendulum is 
well known and will not be repeated here. Extension to the two dime sional 
case is straightforward and the reader is referred to Wahid (4) for details. 
Tho state variables for the pendulum are: 

x = (x,x,O x ,G x ,y,y, 0 y ,6 y ) 

where the angles and relative x,y coordinates are defined in Figure 8. The 
unforced linearized dynamic-: decouple between the (>,0^) and (y,0 ) co- 
ordinates around x=0. Four observations are available via potentiometers: 
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y 3 - y 
y 4 - « y 

(The coupling between y^ and y results from. the 5 
potent iomoter connections). An J LQ (full-state fee: 
signed as described in Wahid (4 ) (Figure 9). Pit 
tnined by digital ,, lend-lag M software (direct diff 
frequency rolloff to prevent noise aliasing) . Thi 
that sufficiently fast update rates could be achie 
C.P.U. A full-order Kalman filter or observer, c 
enough with the 8000. Reduced order compensators, 
ply and two (parallel) processor implementations a 
vestigated with the single C.P.U. design. The per.f 
lized with the LQ gains obtained using an eighth-: 
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re currently being in- 
ilua was easily stabi- 
rcer dynamic model. 


IV. CONCLUSIONS 

The prototype control system design tool described has served to meet at 
least some of the goals outlined in Section 2. Where larger time sharing 
systems are present, interactive high-level languages for control algorithm 
design, simulation, and laboratory evaluation provide a favorable en- 
vironment for both educational and research needs. The essence of our 
approach is the use of a library of macros for performing a broad spectrum 
of common control activities. The user can tailor these program modules 
as his design needs dictate, with code that is relatively easy to use and 
debug. A second generation of the MACGEN language is currently planned 
which will provide an even more transparent collection of mnemonics for 
the required signal processing activities. 
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Fig. 1 Interactive(FORTRAN) Compensotor Design Program 



Fig. 2 Compensator Code Generation for Target System 
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Sample MACGEN Program Implementing a 
Second Order State Regulator 



i 

J&. 


m*n btatcb 

MOM A/9 
Mil A/9 tllVIl 



csunirc iriv 
tour**. 
NflD KATUN 

wiimv 


nr 


tvrniT «rv 

C3WTNOI 10 9/K 

htra e/4 wim 


IE 


RtTWI MCN 
iirri*AuM 


MIN MCtCMN 
loot* 


•“iVtmoVr cv iv* N 
CONVt* u*:ati IOC* 


srss # 8 


Fig. 6 On-line Computation Required by State 
Feedback Regulator 
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ABSTRACT 

A laboratory design facility for digital microprocessor Implementation of 
Linear-Quadrat ic-Cuussian feedback compensator., is described. Outputs from 
user interactive programs for solving infinite tir-* horizon IQ regulator 
and Kalman filter problems are conditioned for implementation on a labora- 
tory microcomputer system. The software consists of two parts: (1) an off- 
line high-level program for solving the LQ Ricatti equations and generating 
associated feedback and filter gains ana (2) a cross compilcr/macro as- 
sembler which generates object code for the target microprocessor system. 

A digital Equipment. Corporation PDP 11/70 with a UNIX Operating System i: 
used for all high level program and data management, and th« target micro- 
processor system is an Intel MPS (8080-ba:;od processor). Application to 
the control oT a two dimensional inverted pendulum is presented and issues 
in expanding t »o design/prototyping system to other target machine 
architectures are discussed. 


I . INTRODUCTION 

The potential impact of microprocessors on cont ol technology hnr. been 
widely acclaimed. While control design method for samplcd-datn systems 
have been known for a good many years (Kuo, (1); Bryson and Ho, (?)) , they 
were until recently only economical for relatively large systems, where 
the cost of A/n, P/A interfaces and minicomputer could bo justified (typi- 
cally 520-30K). However, the complexity of ouch large systems oftt'n made 
tor ting and evaluation difficult, further impeding the implementation of 
cot pu ter controls. 

While the microprocessor has indeed substantially reduced a major cost 
barrier, and more signfii< ally, opened up a wider range of simpler control 
applications, we consider it premature to view the microprocessor ar. a 

. hi research was supported in part in t! Laborat for Infonsati on and 
Decision System:; by NA.‘ A under Grant NGL-22-009-124 nr.d in the Laboratory 
for Computer Science by the Advanced Research Project:. Agency of D.O.P. 
under Contract N001 4-7 5-C- 0061 turn it Tea by tie 0.*f ice of Naval Research 


pain < c a for the experienced control engineer, let .lo: ■■ th j college or 
graduate student. Ironically, the microprocessor has presented new bar- 
riers to the control designer; assembly-language programming, coding lor 
real-time execution, and many other hardwire synchronisation problems. 

These problems are by no means insurmountable but in our opinion they arc 
much alleviated by a development system involving a larger na-hino with 
higher level language and multiprocessing capability. 

Our purpose herein will be to describe a prototype microprocessor design 
facility and to communicate the key insights which have been gained thus 
far in its development. The faci’lty consists of high and ow-lcvel soft- 
ware, computer hardware, and a continuous target application involving a 
two degree of froedom inverted pendulum. 

IX. SOFTWARE DESCRIPTION 

2.1 Design Goa In 

The utility of a laboratory microprocessor control design facility depends 
critically on its software and hardware organization. At the outset of 
this project, several goals were established to address both educational 
and research needs of digital control system designers t 

(1) High level languages should be employed at all design 
levels, in flexible, multi ' ser-interactivc (time- 
sharing) environment; 

(2) A control oriented symbolic language for required data 
processing activities (control laws and filters) should 
be available to simplify use of the system; 

(3) Software developed in the high level language should be 
applicable to many target machines; 

(4) Object code generated should be optimized for the target 
machine to permit exploitation of available processing 
speed 

With these as long term goals for the structure of desirable software, 
a prototype system has been developed in the context of a specific 
(PDP-11) operating system and target microprocessors (Intel G000) . 

The MIT System incorporates several novel features which allow the user to 
accomplish algorithm design in a higher-level language (FORTRAN), develop 
real-time code in using powerful assembly- language macro commands, which 
are translated into relocatable object code and finally cross-assembled 
auto mat ical ly for the microprocessor itself, and automatically down-loaded 
into microprocessor memory. 

2 . 2 LQO C ompe nsator Desig n 

The organisation of the higher-level Fortran routines for LQG compensator 
design is shown in Figure 1. Note that other alternative design packages, 
such as classical f requency-domain or nulti variable frequency domain 
moth ds could be used equally well here. In the prototype system, the de- 
signer does off-line calculations of controller gains by writing very 
elementary FORTRAN programs using these higher-level routines? alternative- 
ly he can employ a specially developed user-interactive program which 
covers most infinite time horizon continuous and discrete filter and 

conti >1 problems. The solution method for this off-line design phase in 
the prototype system employs fairly standard eigenvalue decomposition 
techniques which were developed at the MIT Electronic Systems Laboratory 
(3). The;;*' FORTRAN programs in turn depend on th° "EISPAK" eigenvalue/ 
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eigenvector package developed at Argonne Laboratory* thin is will ly available. 
User dcVfloj>od or available interactive programs for pout-processing of 
control end filter designs (in' ’uJing binulation) ate useful before 
proceeding to generates code fo*. tha target microcomputer systems. 

2 . 3 Cod • j_G. - nerotor for Targ et Micro Computer Sytt en 

After co. ip let ing the off-line design phaao described in 2.2, code to imple- 
ment the control law and/or filter algorithm on the target micro computer 
systom is. generated following the procedure outlined in Figure 2. This 
activity consists of three main parts; (1) Generation of an assembly pro- 
gram using a collection of previously defined control- specific macros 
(MACGEN Figure 3) j (2) Cross assembly of the user generated program (a 
source collection of macros) into executable absolute object code (DOMIC 
Figure 4)» (3) down loading of the absolute code into the target r.ystom. 

Tho DOMIC program performs the steps illustrated in Figure 4 which includes 
binding of tho relocatable user object files from the (MICAL) cross as- 
sembly with tho previously defined control macros, and conversion of the 
resulting files into absolute (executable) code for tho target micro- 
computer system. Tho tedium of performing tlv'co procedures manually is 
thus eliminated for the user. Note that the user-defined macro source 
program written with MACGEN is canonical , in that by use of a different 
cross assembler in MICAL, other target processors can bo employed. For 
example, in our prototype system, both Intel 8080 and Motorola 6000 
processors can be employed ns tho target system. Furthermore, the use of 
special architcctual units such as hardware multiply, array processors, 
etc. can bo made essentially invisible to the control designer since the 
special needs of these units (or even 1/0 devices) are encoded in the 
library of MACGEN routines. All program generation in the above system 
is handled under tho supervision of the host operating system, which in 
the MIT prototype was "UNIX" os implemented on a DEC PDP 11/70. The power- 
ful text editing and file handling capabilities of such systems (or 
similar) nro, in our view, essential ir. an educational or research environ- 
ment so that the user (evident or researcher) can concentrate on the 
control/estimation aspects of the problem. 

2 . 4 A Simple Exam ple 

It would be impossible in this space to enumerate all the capabilities 
of tho current system implemented at MIT. We will be contone to illus- 
trate the heart of tho software, the MACGEN program, with a simple Ex- 
ample. A program for a state regulator with (second-order) dynamics (one- 
input and two-outputs) is illustrated in Figure 5. The general flow of 
this program is illustrated Figure 6, which also illustrates some addi- 
tional special features in our prototype system. The processor is 
as&vcned to be interrupt dtiven by an external clock. At each sample time 
the interrupt routine (INT5:) is serviced. A/D conversions are performed 
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this program ax it resides in the target machine in -xplainod with the aid 
o r figure 5a. When the hardware in inltirliz- l, the program sets up 
•pacified conditions on I/O devices and fetches the required quin data and 
put* it in a tabic. A re. I time monitor program (k:*.\DYt ir. then entered 
wh‘ch can accept simple cv> jrvmds from a temlnal to run, quit, change the 
gains, etc., all on-line. The control up-dates are accomplished by an 
external (prioritized) clock interrupt, which cause-, the brunch to "Int 5". 
The program then returns to the R1ADY monitor program. 

This example illustr.itos the relative simplicity of using the mnemonic 
macros to generate code control updat ing for real-time (interrupt-driven) 
operation. More complex control laws including filters, observers, or 
classical lead-lag compensator!! are easily constructed with the currently 
available collection of macros. 


III. HARDWARE 

3 . 1 Prototype System 

The prototype software described above was implemented as shown in figure 
7 on a DSC PPP 11/70 with G4K of memory, in conjunction with an Intel 0080 
based MDS- 800 (Development) as the target micro computer system. The mds 
system employed hardware multiply, 1GK of memory and was outfitted with 
the D.itel D/A and A/D cards shown. (32 A/D inputs, 16 A/D outputs). Two 
precision D.C. servo amplifiers were provided to drive high power loads 
(up to 10A. 0 28V.) for simple control designs. A number of custom soft- 
ware modules were •$ -ton or adapted from available software to handlo 
communications b • the MDS monitor ar.d UNIX at the 0.6 K-band rate 

(including do..-., -load and plotting of hardware results). We believe that 
our r-’-atora is well above the minimal "threshold" to support the design 
software, although no attempt was rude to define what lowor bound on hard- 
ware would suffice. One the other-hand, more sc '.isticated target system.; 
could have been employed. 

3.2 An Appli catio n 

The prototype system was applied to the design of a two degree of freedom 
inver -vd pendulum. The pendulum was a 60" long aluminum pole mounted on 
a gimbal as show in Figure 8. The gimbal ir. mounted to a large (‘SO" x 48") 
drafting-type X-Y plotter. It consists of a cart which can be translated 
along an aluminum rail to obtain "X" displacement, and the rail in turn 
can be translated to obtain displacements. Motion is achieved with a 
system of cables and pulleys connected to two 28 volt D.C. servo-motor r. 
which can bo driven with the amplifier outputs from the system described 
in 3.1. Linearised analysis of the one-dimensional inverted pendulum is 
well known and will not be repeated here. Extension to the two dinensional 
case is straight forward and the reader is referred to Wahid (4) for details. 
The state variables for the pendulum are: 

x » (x,x,0 ,0 ,y,y, 0 ,0 ) 
xx y V 

where thu angles and relative x,y coordinates are defined in Fiqurc 8. The 
unforced linearized dynamics decouple between the (x.O^) and (y,0 ) co- 
ordinates around x 0. Four observations are available via potent iometers: 


x y . 36y 



(The coupling between and result* from the geometry ot the cable/ 
potentiometer connect! *>nu ) . Aj» LQ (full-state feedback) regulator was de- 
ni gued as described in Wahid (4 ) (Figure 9). Halo variables were ob- 
tained by digital "lead-lag" software (direct dif fercriclng with high- 
frequency rolloff to prevent noise aliasing) . This approach was adopted no 
that sufficiently fast update rcten could bo achieved with a single 0000 
C.P.U. A full -order Kalman filter or observer, could not be up-dated fast 
enough with the 0000. Reduced order cor.pensators, use of hardware multi- 
ply nnl two (parallel) processor impler.tntatior.s are currently being in- 
vestigated with the single C.P.U. design. The pendulum was easily stabi- 
lized with the LQ gains obtained using ar. eighth-order dynamic mold. 

IV. CONCLUSIONS 

The prototype control system design tool described has r.ervod to meet at 
least some of the goals outlined in Section 2. Where larger time sharing 
systems are present, interactive high-level languages for control algorithm 
design, simulation, and laboratory evaluation provide a favorable en- 
vironment for both educational and research needs. The essence of our 
approach is the use of n library of macros for performing a broad spectrum 
of common control activities. The user can tailor those program modules 
as hie design n-'eds dictate, with code that is relatively easy to use and 
debug. A second generation of the MACGIN language is currently planned 
which will pro /Ido an even more transparent collection of mnemonics for 
the required signal processing activities. 
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Fig. 1 Interactive (FORTRAN) Compensator Design Program 
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Fig. 7 Compensator Co:ie Generation for lorget System 
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Fig. 7 Prototype Hardware Realization for 6CS0 Target System 


Fici. 8 Inverted Pendulum and its Gimbal Mounting 

























